#include "../_includes.h"

/////////////////////////////////////////////////////////
// --------------- 气动相关 -------------------------
// 操作方式：Y--左侧翼状态置反
//          A--右侧翼状态置反
//          X--双翼一起打开或者关闭
/////////////////////////////////////////////////////////////

// 初始状态
bool clampstate = false;
bool hangerstate =false;
bool suckstate = false;

// 气动初始化
void pne_init() {
  clamp.set(clampstate);
  hanger.set(hangerstate);
  sucklock.set(suckstate);
}

void handle_clamp(){
  if(ctrl.ButtonA.PRESSED)
  {
    clamp.toggle_state();
  }
}

void handle_sucklock()
{
  if(ctrl.ButtonB.PRESSED)
  {
    sucklock.toggle_state();
  }
}